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(54) WALKING POSTURE GENERATION DEVICE FOR LEG TYPE MOVING ROBOT 

(57)Abstract: 

PROBLEM TO BE SOLVEDrTo provide appropriate 
steps and rotational angles by providing a walking 
posture generation means which performs approximate 
calculation of requirements on the walking attitude 
based on a selected standard walking posture and 
generates an approximate walking posture for satisfying 
the requirements on the walking posture. 
SOLUTION: A standard walking posture data group 
which is prepared on offHine is stored in a ROM 
beforehand (S 1 0). Secondly, an end upper body position 
and speed of each standard walking posture are found so 
as to be stored (SI 2). A timer value (t) is set to 0 (S14) 
so that interruption of the timer is waited (S18). Thirdly, 
a changing point of the walking posture is judged and 
when it is affirmative, the timer is reset (S20) and a 
requirement value to the walking posture is read (S24). 
Fourthly, generation processing of the walking attitude is 
implemented (S26). Fifthly, the walking posture 
generation parameter is substituted (S28) for a target 

walking posture parameter and an instantaneous value of the target walking posture is 
calculated (S30). Sixthly, the time (t) is renewed (S32) by At. BothHeg compliance is provided 
based on the walking posture generated thereby, a target joint angle is found, and the robot is 
driven and controlled for the target value. 
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©<4H ■ sg5££±f*{4H • jM**-^./ 9 

? xjgfltc <£ o r S«IWg8£<a#-!lfcjtc9y£;S *i£ . 

mzztiz. > 

[00671H, jNftt^^y - irttvrc— 
■ffjKMStiTDSfti. c©**S©»»rt*iMf^© 

•TJ:^K:0fc. ft. f^^lSftti*!, ROM84 

©«*^*i»^{c^j(*aw±»*»**3Ba;'c 

30 *^S!/^^-ir©— a<bLrlEttL-C^m>. 

[0068 ] c cr«J»*««:-3«,>r©8iw*lifi'i-* 

il/TSt/. lo©^g«;X©<fc^CC5£SI3nSqCt)<!: 
f(t)©ffl-C^-T «fc 5K.Ltc. 

q(t) : MSttl^iSjai-rSMS! (C©HScffl{*. B#SIJ 1 5C*$ 

©(4a • ^^«S3 tcinT<fc ^ k. ±»©&a • 

f(t): ZMP«lii«:IBa-r^M» (C©M^©ffl«ftrie 
40 ©iD<. I^SStKfcWiZMPOtiaKx.v.z)*^ 

•r) . 

[0069 ] *te**W«[«-'<9>-it*aB(IOrE^ 
©^I54ffl I >S C i <fc ? 2> . 

g( t: a, b, c, d, x(k) , y(k)) : attfliM^rlS^S 
SO B9^[ 



f( t: a, b, c, d) : ZMP«fcamBHtt-SH« (J*S 
a :tm*»SLW&it <P** HSU*) 

b : vmi&ms.w-m'&Gi.B. 

d :K-*P3tfiFW©ZMP©YBE« 
v(k) : ±{*{ig©Yffit|B$S?iJ 

[0070] c©*ie-c«:. «&6yyfc— accv^^-* 
comn-Bfmmsotcibtc, ±<*{4g©n$myjx- -?>\> t> 

*#g£fB5£ r 5 ^ 7 ^ - £ © J: *> K.tBl X (, > £. 
[007 1 ] CC[)|liS©^)S|-C«. CTBltttftS • ilK 

[007 2] C©HSfi©ff^C*JCir»^W^i i, 

mon^s 

qC t: aO, bO, cO, dO, xO(k) , yO(k)) 
f( t: aO, bO, cO, dO) 

m i mm&® 

qC t: al, bO, cl. dl, xl(k) , yl(k)) 
f( t: al, bO, d, dl) 

qC t: aO, b2, c2, d2, x2(k), y2(k)) 
f( t: aO, b2, c2, d2) 

[0073] c tih^im^(Dtnmmms.w-iis • <sm 
tfemmm&¥-&.m ■ mm***. las&ouai ik. 

[0 0 7 4] I47P- • KDSi^JCASSiJiC. 
TC©&g©a&fPfrSfcHJrr.2>. ft. m3^s«. t£M<D 

vmmms.^^ & 3 fcj:tfffifi:©wfflje»£¥im£{4 

[0 07 5] ms&nOJUjt-Zaomiia 



(7) 1 0 -8608 1 
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(k). y(k)£in{sJ{ci&E-r 
[0076] *CT. m3?fr®* 
q( t: a3, b3, c3, d3, x3(k), y3(k)) 
f( t: a3, b3, c3, d3) 

i*J#. ^vM-Zcl. d3te«tO c B$^Jr— ^xSCk), 
y3(k)£fcS"r£. 

[0077] cc-e. mmz&m-rzt. ^y-*a 

xfo^62 &£*©»fp«cj: 2. ) g/ckWJ©^® (0 
10 3^D •>^0tC*jl,^rM«l3>^'7-YT>X$l|^S* 

[0078] C.<Dmfo<DffMX-k*mi<DWMt<Ote.a>. 

20 ^asjg^t') 

2) flk©«ia^a (tfiiigf^a^i') *f9Wci§^. 
-en^e,©s* mmmmoLy-tiLW com 

£C<t 3) (coi,>r»^4©^©^-Cfi4 

[0 0 7 9 ] -efttCjftU 1**7*-* c, dte«fcO*^-- 
^x(k), y(k)©«fc^{C, iSlgia^^-5^-^©fii(CIt» 

30 or^©^f=SrS§fc-rJ:^K:«i*5^3ns^-7y- 

7 * - * <b ft S C <k «{i <h ^ <»:*)&:(, ^ 

[0080] *?c> momm&&un<Dm 1 *jj:o'm2 
^o^^g^sfsiii/r. mm^n^^ 

■OicV^yLlc^OlX- *>-£». C©<fc^(C. JSW^n/c^ 
t«&g©«ift-5^g (SIOSigM) 

40 P?^4. 

[0 08 1 ] CCT, iS*$§©A7>-3i (CCDWiW 

#^) ©*Jsf>^T*SiH^-rst. St^N'^y-^c3, d3*J 
J:0'fi£J3B$^j7— ^bx3(k), V 3(k)«. ^m*>. ^ 
§©^£i$fclT/i:a!>{c. aibK 
JSO-C^kf-So L/*><>> /">*-7j<-2a<fcb©^b«:>!t 

50 £. H)^. a<KiH@€rtf^C<!:K:j;f)^*^©>'-57> 



(8) ftm^ 1 0 - 86 08 1 
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-**#a6SC±*sr#4. * * [0 08 2 ] M»F^»6*aa«fflB«T?**«c6«, 

P(a0+Aa, bO+Ab) = P(aO, bO) + $P /Sal (a=aO,b=bO) * Aa + 8P 
/8b\ (a=aO,b=bO) *Ab- • ■ ififl^ 1 



8P /Sal (a=aO,b=bO) : a=aO,b=bO'CCDPCDaCCH'r^ 



+ ( d2 
x3(k) = xO(k) 
/ ( al - aO ) 
C b2 - bO ) 
V3(k) = yO(k) 
/ ( al - aO ) 
( b2 - bO ) 

[0 08 8] _tifi<D5$; 1 tt 



dO ) * ( b3 - bO ) / ( b2 - bO ) 
+ ( xl(k) - xO(k) ) * ( a3 - aO ) 
( x2(k) - xO(k) ) *( b3 - bO ) / 



20 



8P /Sb\ (a=aO,b=bO) : a^O,b=bOrc7)PCDbCCH3"& 
dSfc$HI 
[0 0 8 3 ] HCC, 

8P /Sal (a=aO,b=bO) = ( P(aO+ Aal, bO) - P(a 10 
0, bO) ) / Aal 

SP /Sbl (a=aO,b=bO) = ( P(aO, bO+ Ab2) - P(a 
0, bO) ) / Ab2 

xfrzox. ififKjUte 

P(aO+Aa, bO+Ab) = P(aO, bO) 
+ C P(aO+Aal, bO) - P(aO, bO) )/ Aal* A a 
+ ( P(aO, bO+Ab2) - P(aO, bO) )/Ab2*Ab 
ia<K^2 

[0 0841 ^1 (Dmmmmte&{&&t2 zzmzntc 
&<dx& o . &m?zm2<DmM<D&m*i&mK. 1 

[0 08 5] g^^O^^y - %<D?£$>1j<DWm%:1& 

So 

[0086] a3^alia2 (DftflWCt&ft tff*J5h ft 
ft. ftft&T. ^<~Z&®<D££X$>-oXi>&l,K m 

x—gunmritn i <omnms8 o<Dnm^m 
&*><dx, fflwmmmc^mmm<D?~2tcttft&, ft 

[0 08 7] Jii rcc um^^s-ztex zy&m t--?^ 

^5££ rsac i j <^5) , 

c3 = cO + ( cl - cO ) * ( a3 - aO ) / ( al - aO ) 
+ ( c2 - cO ) * ( b3 - bO ) / ( b2 - bO ) 
d3 = dO + ( dl - dO ) * ( a3 - aO ) / ( al - aO ) 



30 U 



40 



+ ( yl(k) - yO(k) ) * ( a3 - aO ) 
( y2(k) - yO(k) ) *( b3 - bO ) / 



50 



c3 = (l-(a3-aO)/(al-aO)- ( b3 - bO 
) / ( b2 - bO ) ) *c0+ ( a3 - aO ) / C al - aO 
)*cl+ ( b3 - bO ) / ( b2 - bO )* c2 

itcO, c0iclic2O»»<DfP^ltCtt-DrCi4O"C. 

c3«. cotcit c2 K^-rea^^n-en 

( 1 - ( a3 - aO ) / ( al - aO ) - ( b3 - bO ) / 

( b2 - bO ) ) 

( a3 - aO ) / ( al - aO ) 

( b3 - bO ) / ( b2 - bO ) 

[ o o 8 9 ] ft, ^±^{*g - m&i>mmwtfe>^s 

[009 0] £/c±{*{ig£i$^J:f— :/;l>*>62jctf>£ 

[0091] £tcc<Dt$. a^ftsa&rsfcabccB, 

[009 2] ±&<D^m(fC£^xm&t£®<D^5 S ~ z 

So 

[0 09 3] «T\ 7 • ^t-h*#ISltC 

LfcSWBW^SO?*- R OM 8 4 «C*»8ettS 
tfTlcK fetDiTSo ^l^rS 1 2*Cii<2K 

[0094] jtefc&^fc:iq< . ±1*2 4(E>{4S#IH$(x 

<Dm.m<Dnm<Dm<D&ft*-&#>x as <t -r s . 

[009 5]»^ v S 1 4KiiA,-C*^vffit £0 <h 
I S 1 6*mx S 1 8CCil 

ZA^m^?**'^ (S 1 4CD^^vi^^cC 



15 

£) . 04©?a- • + - httffl&tf. 20msCT£ 

[0 09 6 ] ^>fS 2 OCCit^tfrgCHflO&bO 

U HfSil5itliS2 2CCiIA,t , £-f v^OtCJ-fe 
KU S 2 4 ccjtA,-c#£?&c*t-r -&S#<B <=ftf*tt«: 

a. b) £^<&iMfo 

[0 09 7 ] ^>TS 2 6 (CitA,-C#§<Djl£#ia£tT 
5. 

[0 0 9 8 ] 0 1 4&*-e©mil ; &;^T1f:/Jl'-?-> • 7 
[0 09 9 ] S 1 0 OlCte^-cm&Wcfe'-tz'S- 

[0100] ^>TS 1 0 2 KljIA,-e±fe©tt&135£^ 

<1*5^{C«. -e-©^©^-7>-^ffl*5»BL'/c^ 
-5-y-*©fifcc&S'-<<a<. Sfc. r£tt«. ^-x 

^g©^ 5^-$fii -eoflgfi©^ - £ <B©Pi3tCg 

^fii*5fig-r-2>*>©*3M!R-r-s„ miasi 6(c^-rj: 
[o i o i ] m. mxmsvmmmmxm^zj:? 

(C. PSP >; > ^ 2 ©^g*i±^ 2 4 CCIS-HT +^-(C/Jn S 
g • gS^^-^/cW^t^jgO-Cfc. o-f^ h 1 

[0102] se-^r. nmmms-^ms • *»;<5^- 

S£ r . teiSjEWJE^&g • sS»^ 5 > - # *k - 

[0103] ^-es l 0 4 ^-cii^^©iS^S; 
!£A7^-fK:^i4RAL. S 1 0 6 (CMA^xmiB. 
<D'<U (SCI ) (cjcOig^S©^^^ 

[0104] mAtcmzt. m>x s 2 8 tc m/^x-u^ 
-zffr) KRXL, s 3 0 icm&-cmffi&®<DmB$m 
[ 0 1 0 5 ] 0 1 Tte^wmiifcTjrr-tJ-:^!/-^ • 7 
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a- • f 

[0 106]Jtf, S 2 0 OfCfeOTit^tfrg^^- 
£K:«^n>rB$5iJt©ZMP£3fc«6, S 2 0 2CCjIA/T? 

[0 1 0 7 3 m^x S 2 0 4tCjiA,-CB#£iJ t ©MJS¥ft 
g • «^<bB#^iJ t - A t ©±ffiflc*TOB*» t © 
i^iS;*****. iSj. *©l¥;ffflttftKfcjd5^;rcJ:9K: 
PlB#«:tilg^-5Si]©mBS«:lBiE$nr*sf3. c©2S93© 
10 SgiiSS©Ma?rWb^^©-C. 4rBS-f £„ 

[0108] isH>-cs2o 6icmA,vmiRLtcmm&® 
(-c-^^^t?) ©s!fSi|t©Ji{*&atcs-^i>r5tK: 
^fcg-^S; <5U ) tefi£t,>. b#^ij t ©S^^±(** 

[0 10 9] i&(,>-C04 7Ci- • ? + - h©S3 2«CH 
-?X&iM t * A "t /'cWgLSTL. S 1 8 CCg? rifB©^ 

[ono]i^, ±lE©ia< L/r^£UAi^K:*-5^ 
20 T^wntiti. -x^-eBwmBmm&bix* Bens 

CO 1 1 1 ] 0 1 8^a- • ft-h*#It/ti»3 
30 orwW3>7-^^T>x^fijj5i«S3n^. 

[0112101 9tt^©mi£iiVr-!f-7'.»U--?-> • 7 
P- • + - h-C*"3. S40 0(Ctel>-C6$i^7H2>-^ 

4 4 ©&ttiffi£ii#j£# > s 4 0 2 fcii/i-etfcm<Ba>6 

ZMP©H«iJ{ig (§£J5Rg;W<l>.£) S404 

30 ffiifcio'-rnax^jj?*. s 4 0 6 KMA.xm^^.K. 
S£o-cjS¥©aiftfi***. s 4 0 8 ^CJi^-cMJS ;s ^ 1 © 
s«[4g • mmzxtottrntmicfct-crii?. ». ^ 

[011310187 a- - 5^ + - hCCM-Si. yct>t? 

5 3 0 2 {Cj^-CJS^g • (3>7^WT>^$IJ 
'(Site J: *) miE 5 nfc t % ttigjOl ) te J: O'i^fiig • ^ 

<a©rag5©es^s«rgttu 0. s 3 0 4 icm^mm-t 

40 ©Ub^^a^-y h 1 ^S^ifiJBrSn-Si 

fitsuffli^-s. cn«a(*W{c«m2©?a©^g8 2Wf 
[0114] c©n«fi©ff^«±ie©ip<«fiKt/c© 
vmmftzmi-rzctfiixsz. e«c»*. 'jT^^-f 

50 "C#S. 
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[01151 «fc0i¥o<w. tMB4»tt0fUco(,>T©tt 
M<Dmmc*i l rests s n/c&-? 7»©t§ts#ga> e.-^ - 

[0 116] M(cte±fe©$n<«t(&L;fcc<b#>6. 8S«> 

[0 1 17] idE©to<*fiSUfcC 

■r 5 * * «w < ©(ctb^rm i ©sggig 8 o a>mn 
tAii/iossKfisti, »c. 

(ROM8 4) ©Sfi4>ffiiS3'a-*c 

•5. Htc. &Stt£j®£-<r.5©T\ ^fM ) *>6 5) * 

: mm.?z>&&*. mmm*M?(,c. gsccasc^* 
-c^s. 20 

[01 18]@20«. C©f£3B©Sfl2©5gttS©fl5J8* 

[0119] ^©^©J&egJcfcl^-Ctt. 
ft&c. #g/^^-2tcot,>-c©®g£fflt,>fc. -law 

*£W*^tttR©^tKcfcoT^W£Ijg©?i 

a (jstf r*#g;s7y-*!&aj <tc^) -en 
*fflt>-tv<5^-£©^igs <*sc>tt£<fcs) £jJ?#> 30 

[0120] &*)&wmckz. &gr<9*-*!emt. 
twww£«c*«,>r. w&wtfe'^s-z (m*.». isi 

if) ^swa^HLfcitcc ^©^*J^*Lt^« 

s^--? ^ - *©m{afi^M&/c •) ©eels/* ^ ^ - *©g: 
Ea<ts®-rSo 40 

[0121] ^OMMtLX. «r2©HSfi©^SS(c*Jli 
"CB«W*SW>fflR*iS«l/. -<-X*£g<i:&S*>©/c 

ftnis^s. ^iss^g. <?±# 
sa*. -a©^Lfc^-^^©^i'*ffl^-r* 

[0122] SffcWfCtt. tC*$t>-0<-7 
^-^pfC^-r-S/^^^-irqCSSS^Di (q,p) ilB 
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k#a7=-£x(k)©SK&£Di (x(k),p) 
[0123] J&2©fg;fc©ff^C:tettS£*#!g©£j& 

[0 124] $fc©IS0«iH#§K:fcW*A7y-*a{C 
*J"T'S-'^-7^-^c©®aD0(c, a) Ml S 

!ffe#g<b©IB{fctt> «T©<fc^«:^2>. Cal - a0) *l+ 

D0(c ,a ) = (cl - cO) / (al - aO) 

D0( d ,a ) = (cfl. - dO) / (al - aO) 

D0( x(k) ,a ) = (xl(k) - x0(k) ) / (al - aO) 

D0( v(k) ,a ) = (yl(k) - yO(k) ) / (al - aO) 

[0 12 5] lUSHc. ^0«iSS^K:*}CfS^-7y-f 
b^C*t-T'5>'<7^-^c©®SD0(c. b) 0 
2tfHSg>#g<b©|ifH&tt. KTRDJ: 5 «:&•!>. (b2 - bO) 

D0(c ,b) = (c2 - CO) / (b2 - bO) 

D0( d ,b) = (d2 - dO) / (b2 - bO) 

D0( xCk) ,b) = (x2(k) - xO(k) ) / Cb2 - bO) 

D0( v(k) ,b) = (y2(k) - yO(k) ) / (b2 - bO) 

[0126111 <DmM<Dftii&(D'*5jt-ZisJ:V?-- 

r^2j £<,>5) 

[0 1 2 7 1 c3 = cO + D0( c,a )*( a3 - aO ) 

+ D0( c,b )*( b3 - bO ) 
d3 = dO + D0( d,a )*( a3 - aO ) + D0( d,b 

)*( b3 - bO ) 
x3(k) = xO(k) + D0( x(k) ,a )* ( a3 - aO )+ D 
0( x(k) ,b )*( b3 - bO ) 

y3(k) = yO(k) + D0( v(k) ,a )* ( a3 - aO )+ D 
0( v(k) ,b )* ( b3 - bO ) 

[0 12 8] ±.&&mmtLx®2 Ova- ■ h 
^mursm-r 5i, s 50 0 ia<s^~c* 75 ^o-c 

S5 0 2#>6S5 1 4$vmi<Dm)&<DBB±ffl® 

©®a=&tfors5 1 etcii*. *S©ie^teffl£tf 
[o 1 29] 02 1 «-e©f^*^-r-9-7-;u-^> • v 

0--ft-h-CS)«), S60 0ttg^7>-i' 
©fB^S^filCCifil^-X^^jURL/. S6 0 2iCji 

s 6 0 4 (cjiA/c3£2 ccse ^rfie®^-^^ - f*^?«> 
- ^ >©d3-c$ij8P^»i c t icjm ftmtc » am u 

[0 1 3 0 1 02 Otcm<>)> S 5 1 8te<i:&S5 1 0* 

mxs 5 2 0K^-cg«^g!©(8Bi5Ffii^m-rs„ 



(I!) 

19 

[0131] 02 2lt^r<Dim^mtV-^^-^> ■ 7 
a- • **-HNfc9. Sfn©llJ5S©fiJag<!:|5]fl£K:S7 
0 0*><E> S 7 0 6 £V<D9mZ'ifr>X ±:#<D 
&S.- Z. (SS. S7 06T?«S2©^(D 

l»t@2 0CCJ?-?TS 5 2 2£*ITS 5 0 8tCMr>rW 

[0132] ^2©HiS©^Sgtt±fE©iP< «tfiS;U/cC 
^l©SUS©^Sgi^©^?rf#^C<!:*i-C 

10 

[0 1 3 3 ] {IU 12lSr-E.SSSI^gcDffl^-a-^^^ 

%tt©&«©stt&tsfucs. mux, msnxfc*** 
ccisig-r-So 

[0 13 4] C©£5CCLTftt£l/fc«!|M£§:*}$o-C 

zmtc-r (^-**#g©3:#tt. *©*#§*> 6^-c©^ 
wutc^^jt-^icMb-c^o i -otmifimzz>w& 
c t r ) . Sfor, mi(Dmm<Dm 

[ 0 1 3 5 ] «. »2<!WWII©«»«:*l>t:. KiaB© 
*S{C*fO"C/"t5>--*IBS»»«HWL.(,»ltdK«. 1 30 
o 1 o©*#g(C*f L r AC 5 V - £JfKa£f#-?©-CW:£c 

« v (ROM8 4) <D®m*Wim?2>CL1fiX' 

S. -e-©JS^{C{imi©HJ6©^!SlCl:b«?L-CttS7!>i(C 

[0 13 6] 0J*tf. D0(c, a),Dl(c, a),D2(c, 
a) ,...Dn(c, a) *i««l§J— flTCfc&tt6tf. -£©¥ 

^••7^-^9we^C*jWSD0(c, a),Dl(c, a),. .©ft 
*>9K:DCc, a)*£jIK:<£*. 40 
[0137] H2 3«C©^©^3©Hifi©0»%^ 

[0 13 8] IB3©SSJfc©flSfiSK::toC>Ttt. S8l©StJ&S 
<0»«4l5«©««(*S*ffl«,>*i*«:. SS2©*6t© 

[0139] SI3©Sli!S©^ffi6C*JWSS*^f©^fiR 

[01401 m3©HSS©m®CC*Jt»T{*. $m>*7jt 

»*. -wow i ©sas©»fli©*jsfe'c. m< / )itm2<D so 
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[0141] «*.«. aOSBBE^^^-fOrtOaOK 

etc*fL-ct*mi©H*fi©»ss. b©j£Vtc*tL-rttfli 

2©*te©^S8©#?£ ; &/tH>S<b > ^SC©±5tCtt*. 
c3 = c0+ ( d - cO ) * ( a3 - aO ) / C al - aO ) 

+ D0( c.b )*( b3 - bO ) 
d3 = d0 + (dl-d0) *(a3-a0)/(ai-a0) 
+ D0( d,b )*C b3 - bO ) 

x3(k) = x0(k) + ( *L(k) - x0(k) ) * ( a3 - aO ) 
/ ( al - aO ) + D0( x(k) ,b )*C b3 - bO ) 
v3Ck) = vOCk) + C Vl(k) - yOOO > * C a3 - aO ) 
/ C al - aO ) + DOC yCk) ,b )*C b3 - bO ) 
[0 1 4 2 ] 02 3 4#fl8l/T3iWr-5<!:. S8 00K 

jsK^ett u s 8 o 2i>mtcMA,t:m 1 ommomm 

<tra«©«iffl*fft». S8 16*6i247a--ft 
-KCilA/CS 9 0 0J^MCC:bl>-C4&g©a&*ff9. 
ttcM2 37d--^-p-h©S82 0*>&BI2 57P 

-•^t-hosi ooo«&«cji^wB#ffl*jra-r 

[0143] M3©H)ii©0SSW±sa©iP< ««£L/cC 

<b*>6. fM©£Jt©0tt£Bft©*&»s:fr*-*. 

[0144] 02 6ttC©|feW©m4©^ifi©^«*7S 
T7D- • ^■r-f--C£>S. 

[0145] a»0s*>^»e.nsM^g <s## 
fits •as*^t/rn-5«ifij*s*s©r. 

©**-ttt<&a • iSK£#©fi£#S©MW±{*{48 • 

■ct*. ±{*{ia • att©*w^*tf»ciKrj-sj: 5 
[o 1 46] *©*tt*»Rrr4&. ft-mr i ftc^m 

[0147] mm>mw&vm<DmM<mmtffimx?ih 
u ot. f^*©»j»j±i*{ia • as 

[0148] NaioM%jtt^Sic«>i»r. V)M±#{Z 
a-2S> *S«±*tt«-iMt4»«fcO t ZMP^y-jr 

[0149] C©i©^. iPJULtfrttB • aSiZMPM 
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m.Z&MlcsS'mTZtcibicte. ZMP^-Mi-e-tiCc 

[0150] «Tr«, iSBjj&fSiJHc-f -S/taDCcitt© 

M P * - >{C 2 llfcU:©^ > - £ rt^ST* 
[0 15 1] CCCB, ZMP^7^f-^CD-g|54t>r 

rS5<fc5«C. ZMP^-^-^i-g-CD^-^^-f «r02 

[0152] cn«. ftjig©3im>ff2igrffl^SZMP 

P.. taemcDIUSO^Slrfflt^cCDilSl^cDZMP/^- 20 

«cK»*4il«t<r^lBI©/<9->f-^ t 2 &^H0&< r 

[0 15 3] Sg4©*&&©ff2S6fCfct,>rZMP^7^-- 
£©atf£te. micDSIiS©^*2.C^wm2©ISSS<D^ 

2 <Dmm<D&i&<D^mzum o -c z m p /< 5 > - *©*§ 

iEJIi±(*cDffljE«lSl! ; &«T©^li-C^S-r*ct ^CC 0 30 
fc„ ft. ZMP-^-rf-i^lilEfiCJ:. il£*#g©±{* 

[0154] 02 6*&mL-cm4<Dmm<DBi&<Dm* 
*mi?z>t. s 1 1 oQicis^xmmommmmt 

s i i o 2 cc^r&atii*i&#s©i&4f&i:<*tig • mm. 

£#*TfBtSL/cf£. S 1 1 0 4(cMr«T©M4 
[0 1 5 5] ft-r, Zg^S(C*$^rZMP^-7^-f 40 

ctc#@u c ti^m 2 9 iCTik-r jz^ic Ac tai^m 

[0156] C©<k*> 
Rmix(x(k),c )=Ax(k)/Ac 

£*$<. t©Rmix(x(k), c)£ c (C*f-r-2>x(k)©flie&# 

fc, 03 0 tC^-T J: -5 (C. ZMP^7>-^eK||l/t 
Rmix(x(k),e )£5fc#>&„ 

[0157] ^2©siis©^s§{ctjc»r{t 1 so 
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tci =7 * - 2 (C *f r Z> x(k)©SS £ t # CC. SHJ#J 
^£0r#S©&314£«$b£cA:t^ ai(/fcA7 
^ - 2 1 x(k)£&§K m&OWM'^J - * O/c. 

M&LX. ffi§Ufc^--7J<-^<tx(k)=Sri^<^r©>'N-^ 

«. is 2 © mmmmKm.im*mmm$<<c u tc±dk 

[0158] -XICS 1 1 0 64CjS*. Rmix(x(k), c)i 

Rmix(x(k), Q)<m^t^<om.m<miPh. m^nt^ic 

isWSZMPA^y-fc «:>Ft-r &&4§!Lh{*<ig©flf8& 
^SSSRmixCXe, c). &«±<*j2a©t@flSt#l} { JJ®&R 
roixCVe, c). Z MP^5> - $ e {C*fT-5>$*iBLMfcftg 
©d^WfSaRmixOfe, eX ^ah*2S©(IS![»W 
aS&RmixCVe, e)&:&S:tC «fc 

[0 15 9] Rmix(Xe, c )= Rmix(x(ke) , c ) 
Rmix(Ve, c )= (Rmix(x(ke), c ) -Rmix(x(ke-1) , c )) 

/At 

Rmix(Xe,e) = Rmix(x(ke) , e ) 

Rmix(Ve, e )= (Rmix(x(ke), e) - Rnrix(x(ke-1) , 

e )) /At 

(IU ke : B$ ^J©&f£©I3aJ##. At : l&&ND|ffl 

^frl (att!^©-9->7-;ni#ra) -c&&. 

[0160] X^TS 1 1 0 8(Cji^. 3imcfm.fr h 
miim 1 ?iJ©gsH#Rmix(Xe, c). 18 HtIB 2 ?lj©g 
^#Rmix(Xe, e). ^2tf^ 1 ?U©gS* s Rnrix<Ve, 
c). Jjl2mil2^J©gJ£#iRmix(Ve, e)©2*2?T?"J£ 

[0161] ^»t?S l l l 0«ci^-em&o;fctT?iJ© 

ii^f m^s. c (DmnvKom i ?f is 1 ^j©s^« v 

*Jffi±(*figXe (CStT5^5>-$ cOGSdt&mf&fe 
Rmix(c, Xe). ^2^1^J©fl^«. ^±(*tftSX 
e ICft-fZ^vM-Z e©(g$S^6<J!iSaRniix(e, Xe). 
^Hf»2?0©S^i> &iSLLf*iI&Ve (c*WS'<5 
^-3»c©{SS8t»e«J!SSRmix(c, Ve). m2ftm2n<D 
fetiLkttiSffVe ec^rs^-^^-^e©^ 
^•& { jS«SRniix(e, Ve)i"rS„ 

[ 0 1 6 2 ] jcO, &h®ZU^&®K.*S^X±M?.!m.& 
*aR(c, Xe),R(e, Xe),R(c, Ve),R(e, Ve) £L~C, 
[0163] A^-CS 1 1 1 2 iCMA.-cm^^K.*}^ 

fcAxofc-wg&/MRifo<*tt. -entc^or. ajj^^p®^ 
x(k)£*«>*. 

Ax(0)= AxO 
[0164] C©<t&. 
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Rmix(x(k). xO) = AxOO/AxO 

5rAvO/c^ea/MSSft$ti-. Rmix(x(k), vO)£3fc*?>S. 
[0165]^tCSl 11 4«Cjl* > ^/c/SjSRiDix 
(x(k), xO) iRmix(x(k), vO) <Dteffi£-?:<D\M.til<D$M 

^±&{ia©dgfc#ttBJKRnrix(Xe, xO) . *i*$SBJ:{*iI 

K©<iSt#i*j.®gRmixcve, xo) . wjw±<*iis«c*tf 

SimJbttfi!«©ffltt^^Ri>ixOfe, vO) . **ig± 
&iIK©m#&-J&KRmix(Ve, vO) ^XSlCtot* 10 

[0 16 6] Rmix(Xe, x0)= Rmix(x(ke) , xO) 
Rmix(Ve, xO)= (Rraix(x(ke), xO) - Rmix(x(ke-1) , 
XO)) / A t 

Rmix(Xe, vO)= Rmix(x(ke), vO) 

RmixCVe, vO)= (Rmix(x(ke) , vO) - Rmix(x(ke-1) , 

vO)) /At 

{St/, ke : ftJWKDmk<Dmm&^. At :&i?h?mm 

CO 1 6 7 ] Ml>tS 1 1 1 6«C^-C^-Y-7*0CCU 20 

» h t/TX£- h Sill B*mXS 1120 

Ki^-C 9 S 1 1 2 2tcat^"C 

tttS 1 1 2 4{CjtA/C#-rv£0K:',Hz-, hU 
TS112 6tC^rOSR&<9^~*®K*tf*ll 

S 1 1 2 8<Cj|A,-C»&oa*£fT 5. 
[0168] Bp-fc. 03 S^t/H—?^ -70-'ft 
- h©S 1 2 0 OicmAt-cm Ift^Om 3 <D9m<Dl&1& 
b B«©#j£* flit >t«£#S/"! 7 y - * tARS? £. 
c Office. WJ8_hi*(ag • aa*<l:ac^±ttflUE • m 30 

[0169] {SU ^-^SfcjgiKUcfg. ftJJ8±<* 

SgA^y-^^^l. eei!y©llJfc©^8§<!:|5!*£fe 

[0170] ixt^-cs 1202 cciiA,-e#jw±(*{fia • 

5}?«>. Ctl^AXe.AVei-rS. 40 

[0171] #t>rs i 2 04(cii*> m-g^icto^ 

5te, iftfiaOBt^J^-^ ^tt/i:^© > & 
if&ittftg • 5§K©8M&S A X se. A V se&X&iC «fc 0 

AXse=Rmix(Xe, xO)* A x0+ Rmix(Xe, vO)*AvO 
A Vse= Rnrix(Ve, xO)* AxO+Rmix(Ve, vO)*A 

VO 

[0172] s 1 2 o 4©*&g?«. mm±#&.& ■ mm. 50 
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£t©#g©*S4SJb&{ag • jiS<b©M(i. AXe +A 
Xse. AVe +AVse-C*S„ -ec-CS 1 2 0 6(Cji 

^-©n^ojc-rs^czMP/^^-^w^iEa 

Ac, Ae«riXiC«CJ:-7-C^a).5). 

Ac = Rmix(c , Xe)*(AXe +AXse)+ Rmix(c , 

Ve)*(AVe +AVse) 

Ae =Rmix(e , Xe)x(AXe + AXse)+ RmixCe . 
Ve)*CAVe +AVse) 

[0173] ^Ct>-CS 1 2 0 SlCit/^-CZMP^y- 
*c. e%-X£,t<c£^X#l£>Z. 
c = cmix+ A c 
e = emix+A e 

flL, cmx-Ma%>' ! &<Ortzr J — £ c©fil, emix:jg-& 
*#g© A 7 j* - £ e ©fiTC* 

[0 1 74]^ti2670--f t-KClO, S 

1 1 3 0(c^-cg«#S^-c^y-*(t±iEit^g 

©^7^-*£RA-r-S. fiL. ZMP^^-J'c, 
eidt. S 1 2 0 8-C$!*fcfi*fUt5. »>TS 1 
1 2 2 £ig-CS 1 1 3 2{c^-caS^©SB#fii ; S:» 

[0175] JUWSkw:. 03 4tf^';u-f 1 > • vu- 
■ ? + - h©S 1 3 0 O«:jt^e£Btr©ll]56©0S§£l5l 
«©^fe-C^iJ t © Z M P S 1 3 0 2 (C^T 

^fj©SIIS©»)SS<i:ig«©^-CB$SiJ t ©M£¥©{4a 
• 5£f5&3}ctf>. S 1 3 0 4«lA,-Cgtl*ij!g©±#{iS 

x(k) =xmix(x) + Rmix(x(k) ,c) *Ac + Rmix(x 
(k) ,e) * Ae+ Rmix(x(k) ,x0)* AxO+ Rmix(x(k) ,v0) 
*AvO 

{SU xmix(x) : jg£^©±fl^l$m5>J©k#f*- 
Z-CibZ. ft. gi?fl««BSf Y3fr(6j©±<*{£g€> 

isj^Kc^tt-rscium^s-cfc^t^ *7c. Z^[SJ© 

±#{4S«X. Y^©<B£P)««Cgcabrfc > SfflB© 
[0176] ±geC//c«ttlitcJ;n.r^W{c«02 7 is 

cfcO'0 2 9 fct> b0 3 2 (C^-rje^ftO^i* * C £ 
<»:&»). -efttcJ:i3 03 5K:7jvrj:*>&c. i9rS©^g: 

^ffl^/cg^s^tos-r^ci^-c**. ft. 03 

5CC7j*-3-t£iHT{3:. 

c<0, c+Ac<0. e<0. e+Ae>0 
[0177] ^4©H)Si©^SI{3:±ie©iP<fiJfiSb/c© 

[ 0 1 7 8 ] 0 3 6 {JC©^Bfl<Dm5 ©SU5S©^fii*7n 
[0179] ^©m4©HJfi©^Sg^«. ig^^fCCto 



(14) 

25 

#ffJJ&KRnrix(x(k), c). ZMP^7^-$eK)Pft5 
±^{4a^*?iJ<D<S^WJ!8iaRitrix(x(k). e). VMh 
(*figCC*tr S ±*{5gB#^?IJ©fflS!St^WSaR mix(x 
(k), xo) . «MH±#fltt«:»-r*±{*tiBi*Jfi5>J<Dai 
Sft##JJSgRnrix(x(k), vO) £/BC>Tt,>fc. #t>«. Z 
M P ©«» CC»T * ±#»lil©8f »J© * fOU * B$^?IJ f- 

[0180] m5<Dmm<omm-cit. ^©rc^fc, « 

mi*?*) zm^-c, ±&<ig • satcm? 
[0181] «tk:. co*s©»*js«*iiW-rs. 
(x#ffl) j^(coi.-c®»igift-r&*s. (y 

[0182]B#»H Q±tt2 4Ofl«#s*t.g0K> 

gp{i©ftSK:g<-<T < . *>o$ff B#«c±f*© 
^(c«. zMP©««itc>pf-r4±^{4g • iis©«ati© 20 

<. c©-=e^;u«c*or«3t^2 2 a fc^ibSire* 
6. 

[0183] dxmdl/dt=v 
dvmdl/dt =0)0* (xmcfl - ZMPmdl) 

AdS^©S<i>jIgr* ^. * fc w 0JiiE©SSx-C* D . 

±{*»4>is<* h *$ £&mtimmg.g t mz-x<Dm%*& 

30 

o>0= V (g /h) 

[0184] ±ffif#3*&ff JWjfcfcO-CC^t&^tCtt. IS 
4 ©HiS©^fi§{C*JW S-«f4©W^«S6!ft^'=e7 r ;U 
Rmix(x(k), c) , Rmix(x(k), e), Rmix(x(k), xO),R 
nrix(x(k), vO)©ffch0tC. IM^-tcmmtiMl-^ 

xmdl(t) . vntdl(t) 

[0 1 8 5] ±iZZffintLXm3 6 7a- ■ ? + - h 40 
*#«SLTSi^-ra. ft. ZMP/tjt-XOiBB. m 

4 ©*»«wb»±isi— ccr*. 

[0186] S 1 4 0 0 K*$t,>Tfi|iS*t*g*IEtS 

Ltr*j#. s 1 4 0 2 ccji^&waw®tiM±fttt 
g • jiK*##>rietgufc?£. S 1 4 0 4 CCjfS*. ZM 

PA7ji-$©rtTcie4c = 1, e = 0. £fcp 
(03 5«C=Vr«fc5«:iSSOO{CfcW4ZMP©fiI) = 
0« -e-Ofl&OJnS-eOZMPOfilfcO^ »J»!tfc® ; &xO= 
0 . v0= 0 <t U $g©i^JSB#^J* ■CjRJWtt*^*^!' 
Qfttt&tt'ffU ISMHfc^HfitKxe. teig*?\ii/j$&ve 50 
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[0187] MfttfitCU. 02 9tC*iW£Ac£ 1 CCtST 
S L i * ©A c K J: S Z M P A£ - >*SIEfi£ ^f 5 

&(,>T Z M PA 5 J - £ c tC*fT -Si&ai^eT^HsigXe© 

R(Xe,c) = Xe 

[0188] ^(CZMPA^^-d'cfC^-rS^* 
R0/e,c) = Ve 

[ 0 1 8 9 ] ft, m®9bt)¥*:7)MD*m<DHnte. * 

[0190]^^-CS 1 406tCi*, ZMP^7>- 
f©rtt?cie4c = 0, e=l. gfcp = 0. -£©ffc 
©Jf*-C©ZMP<DI4 0 . *7]8M#ig£x0= 0 . v0= 0 

[0191] m^ZMP^^-^eKWt^t 

^uegxe©(gss»^a*^s:{c <* -,t*»5 0 

R(Xe,e)=Xe 

[0 192] lallttcZMPA^^-^e^-rS^* 

r^m&oimmjm^-x^ic «fc 5. 

R(Ve,e) = Ve 

[0 1 9 3 ] ^>TS 1 4 0 8«:ii*. ZMP^7>- 
*Ofltcie : S:c = 0, e = 0, £/cp = 0. ^-©ffe 
©Sf^.-rwZMPWfil^O. WWtfc« ; Srx0= 1 . v0=0 

Ittlb. **ia5*7 s Jl'{igXe> **^7*Jl<iIgVe£5}<a!) 

So 

[0194] ;xt>r*jj)W*7 r .'i'{igxocc*t-r sj&js^t 1 
;K4gxe©{iSft7>W.®S*^«: <fc o -c^?» 

R(Xe, x0)=Xe 

[0195] IsHitc. fcJJ^^u&gxOicttTrSi&igS* 
^jiSveWdSS^^a^^w: J; r;}<«)*„ 

R(Ve, x0) = Ve 

[0 1 9 6 ] A^VS 1 4 1 OfCji*. ZMP/<7>- 
*©rttcie4c = 0, e = 0. S/cp = 0. -€-©ftfe 
©MWZMP©ffl40. ti)Mtm*x0=0. v0= 1 
ibt. ^©*?«B$?[iJ3;-c. mWjmjl^fJUD&M 

[oi97] ^cb»-ctojn«^attvo(c»r iHMK^ 

R(Xe, v0) = Xe 

[0198] P]««C. ti)M*7 : )l>imvttCtt?Z,fel&*: 
R(Ve, v0) = Ve 

[0 1 9 9 ] -X^-CS 1 4 1 ncji*. c = 0. e = 
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o. p = i . -etDffecD»T*-c©ZMP*o. trmtmz 
xo= o . vo= o t Lx^vi&msmz-zaytmit}^ 

R(Xe, p) =Xe 

[ o 2 o i ] -x^vtJim^r^mBLvo im?*,^* 

R(Ve, p) =Ve 10 
[0 20 2] ^>TS 1412 &Cjt#. 3}?«>/d&g#>6 

^Hf® i^j©g^R(xe, o . mi'im2Pi<D&m 

am(Xe, e) . JS2tTffn?"J©gj?t#SR(Ve, c) . fH2 
tfm2JiJ©gJR*5R(Ve. e) ©2 * 2im*ftf8.?Z. 
[020 3] -X^XS 1414 (CM*. fBiJS Ofctffll© 

j^f^j^r^^So mmkDm 1 ftis 1 ?>j©ssw. »m 
(c xe) . m2'<mim<D&mte. ^Js^r^Hiaxe 

^#T&^'^-£e©(Be8#&-J&gR(e, Xe) . fg 1 
tf*25ll©58Rjat. te^T^jEgVe^^*^^ 20 
- $ c Oflft^eMift R(c, Ve) , ^2 tf SB 2 ?IJ©g3R 

MR(e, Ve)i-T-S„ 

[0 204] ^>TS 1 4 1 6r#-f v£0 8cy-fe* h 
L-tX^-hSt, S1418, S 1 42 0£ilfTSl 

4 2 2<t:mA,T-t£®<D®K>Wt>*) mc&Zfr&frVM 
U SS3n^it«S 1 43 2«cjltfiitfC t 1t5£<* 
nSitliS1 424, S 1 4 2 63rigTS 1 4 2 8(C 
i*A,-C#S©ii-££tT 5. 

[ 0 2 0 5 ] 03 • + — h£#MLT-£©ifc 30 

^©g^a^ta^-rsi. s i 5 o o «:*jc»r^mr© 
ili&©ff^©i>rfta>©#&r®-£i#g?A 

tw©s^*@;/f7^-f i^fiS-rsjag-ctJ^ mm* 

^l»-CS 1 5 0 2te^rM8fc<£M$i«!±f*{a 

5 • jiSS*ffli®^^©»]»3*JJ;i>'^±<*{4S • 
jiffi<t©MAx0, AvO, AXe, Ave£jJ<iii>£„ 40 

[0206] m>r s 1 5 o 4 t,cm?>. ^^(DVMiiL 

a • iIg£Ax0,A vO iU ZMPSO <t l/7ct§£© 
l^ttB • 2SAXse, AVse^>CS;«:J:«)*to-5.. 
AXse=RCXe, xO)*AxO+R(Xe, vO)*Av0 
AVse=R(Ve, xO)*AxO+R(Ve, v0)*Av0 
[0 2 0 7 ] J&CvCS 1 5 0 6CCii#. ZMP^y- 
*©*IEgAc, Ae^tC-tottfeS. 
Ac=R(c, Xe)*(Ax+AXse)+R(c , Ve)* 
(A v+AVse) 

Ae =R(e , Xe)*(Ax+AXse)+R(e , Ve)* 50 
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CA v+AVse) 

[0 20 8] -X^XS 1 5 0 8tCji/^-CZMP/' c ^- 
*c. e£S 1 2 0 QXm*tc<Dtffi\m.K.&r>X$ltb 
•5. »>r0367P-'ft-h<DS143O, SI 
4 3 2£H-Cia3 9 7D- • * + - htCji^, S160 
OfciO'S 1 6 0 2-C^4©H«g©JfJS§i|S]«|(DMa?: 
tfoTS 1 60 4Kii*. ZMP*j8*liE«**«{>*. 
CtiB. 132 Slcis^X'^vJ-Zc =Ac, e=A 
e. ^<Dm<Dtfr&(DZ MP (Dm&0£l,-rc'-< 2 ~>X& 

I 0 2 0 9 ] -X^XS 1 6 0 6 Kit*. ^^Ufijffltia 
• iiS* xmd"l(0)=AxO, vmdl(0)=AvOi U. ZMPmdl 
£OT±iEZMPSlii*liIEfi£A#U ^f 1 ^©*!* 

sat - At) ©&a • as^n (b#sijd ©zmp#i 
@ <B*sa t ) ©aa • j§k*#«>s. fiu &»j©fW8P 

Jaffl-Cl*. *-?)UD*tm<D&S • jlg^ xmdl(0)=Ax 
0. vmdl(0)=Av0i-r-5. ft. BtBrtb^-rt/fctt. mix 

ummmx-mbte.m^htiz-7 v v zxmm*:^* 

[0210] -X<<>XS 1 6 08 kCMA,X,X&.KM'>X . 

^rfi&m^mjEmt isxm&tw&wtcmz.z cite 

J: ~>X @«±#{ia£5fc*!>S. 
x(k) = xmix(k) + xmdl (kA t) 

fiu x(k) : mm±&&.m. 

xmix(k) : ^^(D^WWlUmm^Kom^-H 
xmdl(kAt) : B$£IJkAt©*7^K4a> X&2>. 

[021 1 ] m5<Dmm<DBmit±m<Dtuj<mf8uLtcc 

[0212] £DJM*»tC^»«S«*? , )l'*JIIt» 
ictt&h. ji^'J (ROM8 4) ©gajil^-CS 

k> . mxmntt zk. & r,xt>-r^tj:^nmx v t>vz<< 
A(c±^tdii©^a&*tmt-sci*i-c^-5. c 

[02 13]^. ZMP^--7y-5f(C*f-r-5^±^tt 

a-as©TO*«^fl?^<fc^-c3j<«)6n-5A<. m®m 
tumnz-SAsX^zox. ^-e©<®**«>rietS!or 

[0214] 04 0«C©^©^6©Hifi©^^ 

[0215] 3te«cfcttftfc#. fijfflje»s¥&a. 

^©^fiS^ffiawb-rsci^-c^s. me©n 
[0216] coymmmxmm-r^nxit. fej&mm 
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[0217] JiTF. J7]»3jSWS¥fiS^g!AS^<!: ZM 
[021811407a-' ^ + -h(Cte(,>rS 1 7 0 

o^6 s i 7 i ot-cm5<Dmm<Dmmtmm<D!>m^ 
mxsn i 2Kjitf. ^ecDHJSwjf^-ciiSb^fif) 

[02 19]H|Jfc. S 1 7 1 2 (CfcUTttH 4 1 (Cm? 
«fc^(C. B$StJ0(C*JWSZMP(DfiI*p<t-r4iS(C, 
ZMP^^-^tcieip*. c = 0. e = 
0. p=l. «©ffe©8T.'ST-©ZMP©ffi£0. *7J8!t£ 
<!g£x0= 0 . v0= 0 <t L-r. ^g©*?jffiB#^J*-C^»jS!) 20 

[022 0] #<,>rZMPA^-*p{C#T£il$ii&- ; e 
R(Xe,p ) = Xe 

[ 0 2 2 1 ] IslfiHC, ZMP^7P<-$pK)fft^a 
R(Ve,p ) = Ve 

[022 2] ilitS 1 7 28 £ T-Jfl 5 ©HitoW&Si <t 
HHi©«iai£*T S 1 7 3 0 CCii/CT-#!g<Di!££tf 30 
5. B|1%. 04 27a- • 3^ + - KDS 1 8 OOfCfcO 

[0 22 3] ffiU ^<-X&®ZmiRbtc'&. V)M±.#- 

am ■ mm. **48±<*{4h • as. vmwEwm* 
ee^-c. CT«s±(*{4g • its. »JS±f*fiis • a 40 

*#£?©£$ ©{lift*. 

[0224] m>-C S1802. S1804 ©*aS£ifl 
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